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1 Introduction 


1.1 Overview 


This report summarizes the research effort and results related to the Grant No. NAG 9- 
462/Basic from the NASA Johnson Space Center (JSC). The overall goal of this research is 
to develop a general theory for the control of flexible robots, including flexible joint robots, 
flexible link robots, rigid bodies with flexible appendages, etc. As part of the validation, 
the theory is applied to the control law development for a test example which consists 
three-link arm modeled after the shoulder yaw joint of the space shuttle 
system (RMS). The performance of the closed loop control systemjs * 
performance of the existing RMS controller to demonsti^jA»>^r^O^' 
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in this research are noted 
and low power consumption, these 
..,pulators as well. 


1. Tl. ^ - ui comparison with the motor inertia, even when the joints are 

hea ^ -icti (so the motor inertia seen from the link is multiplied by the square of 

the gear ratio). This implies large inter-link coupling, especially in the mass matrix. 


2. The gearbox model includes a nonlinear spring and hysteresis. 

3. The payload is massive compared to the arm (two orders of magnitude larger). 

4. Amplifier output, motor torque, joint and Cartesian velocities are limited. 

Based on the simulation of the three-link test arm using the existing RMS controller, the 
following attributes of the current RMS controller performance have been observed: 
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droller only uses local motor velocity feedback (digital velocity PI loop in 
plus analog tachometer feedback). This choice has the advantages that link 
d angular velocities need not be measured and the control law is very simple, 
wback is that the inter-link coupling and link angular error are not directly 
;ated. Since the links are very massive compared to the motor inertia (even 
ivy gearing), this coupling is quite sizable. As a result, there is a significant 
of uncommanded motion; for example, if a single joint is commanded to follow 
y profile, there are large transients at other joints, causing large position errors, 
the end effector is commanded to follow a Cartesian velocity, large deviations 
other directions. 

trol strategy is to drive the motor velocity (reduced by the gear ratio) to the 
ink velocity and then let the link oscillation damp out through the link friction, 
ently, the motor velocity may be adequate but the link velocity performance 
sh. This problem exists even in the single flexible joint case, the inter-link 
only compounds the problem. 

iting RMS controller appears to be very robust in terms of stability. Load 
ioes not affect stability but the transient performance differs significantly for 
sd and unloaded cases. 

he above observations, we have set out to understand the existing controller 
n particular, the apparent stability robustness) and to develop a new design to 
:esent shortcomings. The following objectives are formulated for the modified 
y are also used to compare the closed loop performance between controllers: 

he amplitude and duration of oscillations of the link velocity while increasing 
of response, 

the effect of inter-link coupling, 

l stability and performance robustness with respect to the payload and arm 
ition. 

l internal stability, i.e., motor torque and velocity should stabilize. 

these objectives, we have focused on a recently developed method which 
issivity property of flexible robots [1], Application of this method to flexible 
nd, in particular, to our test arm, leads to a large family of stabilizing control 
d justifies the existing RMS control law. A subclass of this family, has proven 
Eective in terms the performance criteria stated above. The structure of this 
Hers basically consists of the kernel of the existing RMS controller augmented 
riable dependent feedforward. Results in this report mostly pertain to this 
.nalysis and simulation (for performance comparison) of the new controllers, 
the following assumptions: 

state measurement is available, namely, link angles and angular velocities, 
Dr angles and angular velocities. In contrast, the existing RMS controller only 
>tor angular velocities and angles (obtained by integrating angular velocities). 


2. Some controller limits, and hysteresis (unit efficiency for both forward and back drive) 
are ignored in the analysis. Velocity limit logic has been implemented in simulation. 
In most of the simulation results, torque limit has also been included. 

3. The arm dynamic model is known exactly. 

We are in the process to relax all of these assumptions. A nonlinear observer is under 
investigation for the first case, a saturation-driven command trajectory modifier is considered 
for the second, and robustness analysis and adaptive control is being studied for the last. 
These directions of generalization will be discussed more fully in Section 6. 

1.2 Introduction to Passivity Approach 

Passivity is an input /output property which roughly means that energy can only flow into 
the system (in other words, the system can never generate energy through the input/output 
pair). For flexible joint robots, the passive pairs are the motor torque and motor velocity. 

The basic structure of our proposed controller is the sum of a model-based feedforward 
and a model-independent feedback. The procedure of control design for flexible robots 
involves two steps: feedforward design and feedback stabilization. These steps are explain 
further below: 

• Feedforward Design: A feedforward control (possibly dependent on the full state mea- 
surements) is chosen to form an error equation so that the system is passive between 
a particular input/output pair. 

• Feedback Stabilization: The stabilization procedure involves first finding a static feed- 
back (usually the position proportional feedback) to guarantee observability and main- 
tain passivity and then choosing a strictly passive feedback from the passive output. 

The passivity approach described above has the following important features: 

• The feedback portion is independent of the model, so the closed loop stability is ex- 
tremely robust. When the feedforward is inexact or absent altogether, the stability 
is still maintained, but the steady state error will increase proportional to the model 
mismatch. 

• Only the output (i.e., motor position and velocity) is needed for the stabilization in 
contrast to the full state in the exact linearization. 

• The controller structure is a simple form of stabilizing feedback summed with a feed- 
forward. This clean separation of functionality between the two loops is particularly 
amenable to adaptive control. In contrast, the two loops are intertwined in the exact 
linearization approach. 

• For the tracking control, the choice of feedforward greatly impacts performance. We 
have found that it is particularly effective to add a link angle and angular velocity 
feedback component in the desired link acceleration. 
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This approach is applicable to both (position) set point stabilization and tracking control. 
In the set point control case, the feedforward is particularly simple to solve and is usually 
a constant. In the tracking case, essentially the plant needs to be stably inverted. We will 
later discuss various approximation that we have used. The rate control used in RMS can 
be cast as a special case of the tracking problem. 

Passivity of mechanical systems has long been recognized as an important property. This 
property has been used in the feedback stabilization for fully actuated rigid robots [2, 3, 4, 5], 
satellites [6, 7, 8], and flexible joint robots [9, 10], Passivity property for flexible jointed robot 
was recognized in [9] and indeed was used in a proportional-derivative (PD) type controller 
design. The method requires inherent damping in both joints and motors. Similar results 
without requiring the inherent damping have recently appeared in [10], The result on PD 
stabilization of flexible beams was first shown in [11]. 

The passivity property of flexible structures with collocated sensors and actuators was 
noted in [12] when the inherent damping is present. The controller structure, however, is 
invariably of the simple PD form. As a result of the low damping, the transient performance 
is typically poor. It was only recently noted that an undamped beam can be stabilized by 
using PD alone [11, 13]. However, as the open-loop poles and zeros are on the imaginary 
axis, transient performance is poor. In [14], based on the work in [15] for rigid robots, the 
PD structure is generalized to a general passive controller for a multiple-flexible-link robot. 
However, in contrast to [1], intrinsic structural damping in the flexible links is required. 

Another prominent approach to the control of flexible joint robots is exact linearization. 
There has been many published work on this application, for a summary see [16], In general, 
this approach requires the exact model information, linear spring assumption, and zero 
gyroscopic force coupling. Furthermore, the feedforward compensation (for linearization) 
and the feedback stabilization are intertwined and errors in the feedforward may affect the 
closed loop stability in an adverse way. The feedforward design in our approach is very 
similar to the exact linearization approach - both essentially solve an inverse plant problem. 
But our approach requires much less model information in the set point control case (only 
the spring characteristics is needed), can be extended to the nonlinear spring case and fully 
coupled dynamic model, and the additive separation between the feedback and feedforward 
implies that error in feedforward does not lead to instability. The price to pay is that the 
closed loop performance cannot be arbitrarily assigned. 

1.3 Organization of Report 

This report gives a self-contained exposition of the passivity control theory for flexible robots 
and also presents simulation results for a three-link arm to demonstrate the effectiveness of 
the scheme. In Section 2, the full model for the three-link test example is presented, includ- 
ing the gearbox characteristics. This material is largely based on the original SPAR report 
[17] and some additional notes from Richard Theobald at Lockheed [18]. The full model is 
used in a “truth-model” simulation. We have also used a simplified model (with satura- 
tion, hysteresis, and quantization ignored) for controller design and performance comparison 
between the RMS controller and the proposed controller. The existing RMS controller is 
explained in Section 3. Again, much of the materials are from [17], some of them are in- 
terpreted in a passivity perspective. Several different versions of the modified controller are 
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presented in Section 4. The performance of the two controllers is compared in Section 5. All 
of the simulation results are presented here. Proposed future extensions are summarized in 
Section 6. 

The general theory of passive control design methodology for flexible robots is included 
in the Appendix. 

2 Modeling 

In this section, we present the dynamical equations for the three-link test arm. The general 
model is based on the description in [18], [19] and [17], Additional assumptions are made to 
obtain models for a high fidelity simulation based in FORTRAN and for a proof-of-concept 
simulation based in MATLAB. These assumptions are based in part on the classification of 
critical and non-critical parameters as in [20], and in part on the expected applications. 

2.1 General Assumptions 

Arm geometry and mass properties parameters are considered as non-critical parameters in 
the sense that their variations do not affect the arm performance significantly [20]. Crude 
estimates of the related parameters can thus be used for the study. Among the servo parame- 
ters, only the gearbox stiffness, gearbox forward/backdrive efficiencies, motor drive amplifier 
gain, forward/backdrive current limits, joint and motor friction/stiction, and brake torque 
are considered as critical parameters [20]. Hence, a precise model of these elements should 
be used. However, approximations of some of these elements are used for this study in order 
to simplify the controller design. The controllers will be tested with the precise model at a 
later date. 

2.1.1 Mass and Geometry Properties 

The test manipulator is a three-link planar arm (shown in Fig.l). The links are considered 
to be rigid (i.e., bending stiffness is neglected) uniform homogeneous cylinders. The link 
parameters are enumerated in table 1 where the inertia of each link is referenced to the center 
of gravity of the link which is at the geometric center and is expressed in the corresponding 
joint reference frame. The joint reference frame is rigidly attached to the link at its inboard 
end. 


Table 1: Arm parameters 


Variable 

Name 

Link 1 

Link 2 

Link 3 

Units 

length 

h 

7.315289 

7.315289 

1.828822 

m 

mass 

rrii 

175.1825 

175.1825 

43.79562 

Kg 

inertia 

u 

781.2183 

781.2183 

12.2065 

Kg • m 2 
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Figure 1: Three-link planar arm and payload 
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The baseline payload is a homogeneous cylinder and is representative of a typical module 
to be handled by the RMS. The characteristics of the baseline payload are enumerated in 
table 2. It is assumed that the payload is grasped by the manipulator by its center such that 
if the payload is considered as a point mass, the point mass will be in the axis of link three 
at a distance of half the diameter of the payload from the end effector (see Fig.l). 

Table 2: Baseline payload parameters 


Variable 

Name 

V r alue 

Units 

mass 

m pl 

20875.9124 

Kg 

inertia 

kpi 

351046.558 

K g ■ m 2 

length 

lZpl 

13.71617 

m 

diameter 

y pi 

4.267252 

m 


The manipulator and load dynamics are described by the following equation: 


Tjoint — M(9i)9i + C{9i^9i)9t + Tfl{9i) + T ext 


(i) 


where 9( represents the link angular positions, r Joint the torque applied at the base of the links 
(i.e., gear torque), Tfl the stiction/friction link torque and r ext the effect of external forces 
applied to the arm. The mass matrix and centrifugal/Coriolis torque are of the following 
form: 
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Cl3 = 

-h ■ [lc 3 • ^3 + / cp ; • mpi] ■ S 23 

(14) 

C 21 ~ 

-C 12 

(15) 

^23 — 

— ^2 ’ [^c3 ' m 3 + l C pl ' TOpi] ' ^ 

(16) 

C 31 = 

— c 13 

(17) 

c 32 — 

— C 23 

(18) 


where /„• = li/2, l cp i = / 3 + l p i/ 2, /, = m, • / 12, C2 = cos(0 2 ), C3 = cos (0 3 ), C23 = 

cos (# 2 + $ 3 ), S2 = sin (0 2 ), 53 = sin (# 3 ), 523 = sin (# 2 + $ 3 )- 
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Figure 3: SRMS controller 
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2.1.2 Joint Servo Model Description 

The joint servo model for each joint is shown in Fig. 2 and the existing RMS controller is 
shown in Fig. 3. The three joints in the manipulator model for this study are identical and 
the parameters are listed in table 3. The motor drive amplifier is modeled as a constant gain 
I< A . The motor time constant T m is ignored. The motor shaft and the gearbox input shaft 
are one and the same so that the moment of inertia for all the component rigidly attached 
to that shaft are included in the gearbox input moment of inertia J m . The motor brake and 
stiction/friction functions are modeled by a single nonlinear function as shown in Fig. 4 
where 



\M 

(T B o-T c )-e u +T C 



(19) 


where v represents the rate of transition from stiction to friction. Application of the brake 
increases the stiction/friction level to the sum of the motor stiction/friction plus that of the 
brake. 


Table 3: Joint parameters 


Variable 

Name 

Value 

Units 

Motor inertia 

dm 

3.6755E-4 

Kg ■ m 2 

Motor constant 


0.081345 

N-m/V 

Back Emf 

I<b 

0.235 

V/rad/s 

Motor friction 

T m } 

0.02819957 

N ■ m 

Motor friction (brake on) 

T B r 

0.4430586 

N ■ m 

Torque limit (fwd) 

T f 

0.9057755 

N ■ m 

Torque limit (bkd) 

T b 

0.5139642 

N ■ m 

Motor drive gain 

I<a 

1.92 

V/V 

Motor drive output limit 

L a 

20.0 

V 

Output friction 

To} 

54.9485 

N-m 

Gear ratio 

N 

1841.95 


Gearbox stiffness 

K g 

0.47153 

N • m/rad/ s 

Backlash angle 

A 

1.6872 

rad 

Torque at A 

T± 

0.23 

N ■ m 

Efficiency (fwd) 

VF 

0.78 


Efficiency (bkd) 

VB 

0.845 


D / A gain 

I< DA 

0.1615 

V/cnt 

D/A input limit 

Ld 

63 i 

cnt 

Digital tach. gain 

I<d 

11.378 

cnts/rad/s 


The effect of the motor drive amplifier current limit is included as a torque limit in the 
motor model. This torque limit depends on the motor mode of operation, i.e. forward 
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Figure 4: Motor brake and stiction/friction functions 


drive or backdrive mode. Motor forward drive mode corresponds to the case when the 
gearbox is forward driven by the motor and similarly for the backdrive mode. The motor 
forward/backdrive logic is as follows : 

Motor forward/backdrive logic 

IF sgn(r m ) • 6 m > 0.17580 rad/s THEN torque limit = T F 

IF sgn(r m ) ■ 6 m < 0.17580rad/s THEN torque limit = 7# 

where the motor torque r m is defined as (Fig. 2) : 

r m = (V a - K b ■ L) ■ Kt/Rl (20) 

The servo drive amplifier output is saturated at La- The link stiction/friction characteristic 
is the same as that of the motor-brake stiction/friction. 

The gearbox is represented by a single stage model where the backlash of all the gear 
meshes is concentrated in a single mesh and is modeled as a nonlinear spring function where 
the function represents the gradual increase in stiffness as more and more of the planetary 
gears of the gearbox mesh. The nonlinear spring function is shown in Fig. 5 where 

_ f T a ■ {S/A) 2 ■ sgn (S) if | S |< A , , 

G \ I<G ■ S + (Ta - I<G • A) • sgn {6) if | 6 |> A ; 

The gearbox efficiency depends on the gearbox mode of operation, i.e. forward drive or 

backdrive mode. The gearbox forward/backdrive logic is as follows : 

Gearbox forward/backdrive logic 

IF 6 m ■ 6 > 0 THEN r] F (forward drive) 
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Figure 5: Nonlinear spring backlash model 


IF 6 m ■ 6 < 0 THEN rjB (backdrive) 

Note that tjf, t]b < 1. 

Finally, the orbiter dynamics and attitude control system are ignored. Also, we assume 
that no external force is exerted on the manipulator. 

To summarize, the complete equations of motion (with voltage input V a ) are given by: 


r m - [sat (V a • I\ a ,L a ) - K B • 0 m ] • I<t/Rl (22) 

0 m = J m ■ [ sat ( r m, (3>, T B )) - T B {0 m ) - Tq ■ (t} B , 1/t)f)] ( 23 ) 

<5 = e m -N-e ( 24 ) 

_ f T& ■ (<5/ A) 2 ■ sgn(<$) IF m<A 

G \ K g -6+{T a -K g - A)-sgn(tf) /F | <5 1> A 1 j 

N -t g - t fl (6 ( ) = + C(9(,6()0£ (26) 


2.2 Baseline Control Mode 

2.2.1 Resolved Rate 

The resolved rate mode of control is the baseline mode for the system. The joint rate 
commands are computed from the inverse Jacobian: 

*«*. = ‘ Vu. (27) 

where = [Odes, ides,i/des is the command velocity of the point of resolution (POR). 
For this study, the end effector is used as the POR. The Jacobian matrix in a coordinate 
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system fixed at the shoulder joint and aligned with the base (Fig. 1) is given by: 


J = 


1 1 1 
(-/ x • 51 - / a • 512 - h • 5123) (~/ 2 • 512 - l 3 • S123) (-/ 3 • 5123) 
(h • Cl + l 2 ■ C12 + / 3 • C123) (l 2 ■ C12 + / 3 • C123) (/ 3 • CT23) 


( 28 ) 


where Cl = co$(0i), CT2 = cos{6i + # 2 )> Cl 23 = cos(9i + d 2 + #3), 51 = sin(&i), 5 12 = 
+ 0 2 )> 5123 = sin{9\ + 62 + $ 3 ). 


2.2.2 Rate Limits 

In addition to using the resolved rate mode of operation, the manipulator is also a velocity 
limited device. The RMS is velocity limited at the joints and the end effector. In this study, 
a single joint rate limit is considered since all the joints are identical. Also, rotation and 
translation velocity limits are assumed decoupled. The end effector limits and joint rate 
limits for the unloaded manipulator and the manipulator with the baseline payload attached 
are given in table 4 where 

Knax = \/ iLx + 2/rnax (29) 


Table 4: Rate limits 


Variable 

Payload 

Units 

Unloaded 

Baseline 

imax 

0.36576 

0.03048 

m/s 

2/max 

0.36576 

0.03048 

rajs 

v 

v max 

0.36576 

0.03048 

m/s 

$max 

0.04 

0.003 

rad/s 

9, 

tmax 

0.04 

0.003 

rad/s 


The rate limiting algorithm is such that all the rates are scaled down if a cartesian velocity 
limit or a joint rate limit is exceeded. Hence, the same path is followed but at a lower rate. 
The logic is the following : 

1. IF command given in joint space 

(a) V de3 = J ■ Q (d ' S 

2. END 

3. Saturate the cartesian velocity 

(a) T\ — |i(iej|/2: m ax 

(t>) r 2 = ly^l/jwx 

(c) — Iv/^des 2 T UdesH^' max 
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(cl) r 4 j^des|/^max 

(e) r = max(l,r u r 2 ,r 3 ,r 4 ) 

(f) = V des /r 

4 - = ^ _1 • Vdes 

5. Saturate the joint rates 

(a) FOR each joint, compute : Sj = \0 (j \/&t max 

(b) s = max (l,Sj) 

( C ) ^ = K's/ S 

2.3 Fortran Program Assumptions 

This program is used as a high fidelity simulation. It includes the complete model of the sys- 
tem as described in section 2.1, except for the electrical time constant, feedback quantization, 
and digital tachometer processing. 

The logic for the implementation of the motor brake and stiction/friction is described by 
the flowchart in figure 6 (see Figures 2 and 4 for the variables definition). The logic in the 
flow chart allows the motor to come to a rest even though a discontinuous feedback function 
is used. 

A similar logic cannot be easily implemented on the link side due to the inter-link coupling 
torques. However, since the link inertia is relatively large when the baseline payload is 
carried, only insignificant numerical oscillations can occur due to the discontinuous feedback 
function. Therefore, the friction function without the logic is used for the links. 

The following is a list of features that are supported by the Fortran program: 

• All nonlinearities are included, such as 

(i) gearbox nonlinearity and hysteresis: nonlinear spring, variable efficiency. 

(ii) centrifugal/Coriolis torque. 

(iii) limits for torque, voltage command, integrator, measurement, velocities (link and 
Cartesian space). 

(iv) friction for links and motors. 

• Sample and hold circuit is included. 

• Simulation is performed with an efficient ODE solver which allows control of both 
relative and the absolute errors. 

• States are scaled in order to take advantage of the ODE solver error controls. 

• Parameters for simulations are initialized by data files which allows easy modification 
of the operating condition and system parameters. 

• Velocity reference signal can be defined in Cartesian space and in link angle space. 
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2.4 Matlab Program Assumptions 

To quickly experiment with different structures and parameters for the controller, we have 
also developed a simplified simulation program within the interpretive MATLAB environ- 
ment. The assumptions posed in addition to those in the FORTRAN program are listed 
below: 

1. The brake stiction/friction is replaced by the motor friction T m f, i.e. they are consid- 
ered as having the same value. Also, the link stiction/friction is replaced by the joint 
friction. The logic for the implementation of the motor brake and stiction/friction is 
described by the flowchart in Fig. 7 where e is a small positive number (see figures 2 
and 4 for the variables definition). 

2. The gearbox is assumed to have unit efficiency. 

3. Only the motor torque limit and the velocity limits are considered, i.e., the servo drive 
amplifier output voltage limit and the electronic circuit limits are not considered. The 
motor torque limit is assumed unique, i.e. does not depend on the motor driving mode 
(the forward mode limit level is used). 

Except for those assumptions mentioned above, this program shares all other features of the 
Fortran program described in section 2.3. 
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Figure 6: Stiction/friction and brake model flow chart 
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Figure 7: Motor friction model flow chart 
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3 RMS controller 

In this section, the existing RMS controller is described and briefly analyzed. 


3.1 Description of RMS Controller 

The main idea behind the RMS controller (shown in Fig. 3 and table 5) is to rotate the 
motors at the desired link velocities (scaled by the gear ratio), and because of friction and 
joint spring, the links will eventually also stabilize at the desired velocities. Hence, only the 
motor velocities are controlled. 

The controller is composed of the following elements (some of the terminology is different 
than that in [17], for example, proportional and integral feedback in [17] means velocity and 
position, since velocity feedback is considered as the primary loop; here we use the convention 
based on position feedback, so proportional and derivative feedback means position and 
velocity feedback): 


1. Proportional-Derivative (PD) controller with low pass filter. The purpose of 
the proportional feedback is to provide a high gain at low frequencies to break motor 
and drive train stiction and eliminate small errors. The amount of proportional feed- 
back is limited at ±Lt . Position error is obtained via integration of the velocity error. 
Integration stops when the limit is reached; it resumes when the input of the integrator 
changes sign. This controller has the following input/output transfer function : 


• Not in limit mode : 


• In limit mode : 


v cl 


\[Ktr + 1 ) + 

[t/S + 1 ] 


V c i = ±Lt + 


Cl 

[t fS + 1 


(30) 


(31) 


2. Analog tachometer and high pass filter. This element is used to improve the 
transient performance of the controller (it slows down the motor response, resulting 
in smoother transients). The high pass filter is composed of two stages with a limiter 
(figure 3) and has the following transfer function when it is not in limit mode : 


V c2 


h • K r • s 2 ] , 

ns + 1] • [r 2 s + 1] m 


(32) 


3. Command shaping. This module is used in order to maintain accurate steady-state 
response in presence of limiting of the integral term of the velocity error. The command 
shaping is described by the following equation (figure 8): 


f Kd-L^ IF | L d J<L 
\ Ki-L^-Kz if \e md j >L 


( 33 ) 


19 



where 


'«*. = N-d (d „ 

(34) 

L = It -K A ! K b 

(35) 

AT - Ko+ Kda . Ka 

(36) 

Ai = kL sgn 

(37) 



Figure 8: Command shaping 

We note that the scaling depends on whether the velocity integral term (i.e., propor- 
tional feedback) is sufficient to compensate for the back emf due to the commanded 
joint velocity scaled by the gear ratio. If it is sufficient, the commanded motor velocity 
is the commanded joint velocity scaled by the gear ratio and by the tachometer gain. 
Otherwise, a term is added to compensate for the back emf and another one to subtract 
the velocity integral term. We note that the back emf is compensated in steady state. 
However, there is no compensation for stiction/friction and for the loading effect of the 
gearbox which will lead to a steady state error. 

NOTE : The values listed for L, AT and I\ 2 in table 5 do not correspond to the 
values obtained by applying (35), (36) and (37). Values in the table were obtained 
from [18] and are also listed in [20] where no explanation is provided to explain the 
change of values. These changes may modify the above comments regarding which 
effects are or are not compensated if the integrator saturates but does not affect the 
results presented in this report since the velocity integral limit is not used. 

The complete controller has been implemented in the Fortran program while not all the 
limits are used in the Matlab version. In particular, the limit on the velocity integral L ? , the 
limit on the high pass filter A/, the limit on the D/A converter input L D and the voltage limit 
at the output of the motor drive amplifier L A are not implemented in the Matlab program. 
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Table 5: RMS controller parameters 


Variable 

Name 

Value 

Units 

Integral trim limit 

Lj 

1.5 

V 

Integral trim gain 

I<tr 

0.05 

s~ l 

PD contr. filter time constant 

T f 

0.1 

s 

Analog tach processing gain 

Ki 

6.12 

V/rad/s 

Analog tach pro. time constant 

T\ 

0.1 

s 

Analog tach pro. time constant 

T 2 

6.1 

s 

Analog tach pro. output limit 

Li 

13.0 

V 

Command shaping 

I<i 

11.378 

cnts/rad/ s 

Command shaping 

I<2 

6.757 

cuts 

Command shaping 

L 

8.86 

rad/s 


3.2 Analysis of RMS Controller 

The main characteristics of the controller are : 

• Controller uses only motor velocities (motor PD control + analog tachometer feedback). 

• Motor velocity is brought to the desired link velocity and link oscillation damp out due 
to link friction. 

• No corrective action is taken by the RMS controller if the motor torque saturates or if 
any other limit is exceeded except for the velocity integral limit (by the use of command 
shaping). Also, steady state correction for the velocity integral limit is not exact in the 
sense that it does not consider the loading effect of the gearbox and the motor friction. 
This may lead to a steady state error. 

• Joints are assumed decoupled. 

• Stability is maintained in presence of load changes. 

Some problems were observed : 

1. Coupling between the joints causes uncontrolled motions. For example, given a velocity 
command in the x-direction, the orientation and the y-position both vary during the 
motion and deviations are not corrected by the controller. 

2. Link velocity oscillations damp out slowly. 

3. Link errors are corrected slowly; the controller must wait for the motors to be affected 
before any corrective action is initiated. 

4. Small proportional feedback gain (i.e., the velocity integral gain) leads to large link 
position error. 
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5. Larger errors are observed when limits are reached. 

These problems are caused mainly by the lack of link angle feedback, the large coupling 
between the links, the nonlinear spring characteristic of the gearbox, the small inertia of 
link 3 (higher frequency natural mode) and the inexact or nonexistent compensation for the 
limiters. 
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4 Modified Controller 


As described in section 3, the RMS controller consists of two loops. There is a digital joint 
feedback loop that is closed at 8.75ms: 

u m\ — ~ Fp m (9 m ~ @m dc3 ) ~ k Vjn Z ( 38 ) 

where z is the low pass filtered version of the motor velocity error 9 m — 9 mies . An analog 
high pass motor feedback is added to the output of the digital loop: 

u m2 = H(s)9 m . (39) 

For the RMS controller, H(s) is given by 


H(s) 


Tikis ' 1 


(40) 


(T[S + l ) 2 

where 77 = t x = r 2 in Table 5. The overall motor voltage control signal is given by 

u r/i \ T . 

The proposed controller builds on top of the RMS controller. The following modifications 
have been tried, to varying degrees of effectiveness: 

1. A feedforward term is added, so the motor voltage is now: 

W m = U m , U m 2 4“ j j ■ 

The structure of the many possible feedforward signals will be discussed below. 

2. Several different alternate filters are tried in place of the high pass filter. 

3. Smoothed desired rate trajectories are tried in place of the step. 

The rest of this section describes these modifications in detail. 


Feedforward Design 

As described in Section A. 6 of the Appendix, the basic idea behind the feedforward design 
is that given the desired output trajectory, 9e de) (t), t > 0, in the flexible joint robot case, 
find the desired state (i.e., 0 mrfea (i), since #^ eJ (<) is given) and the feedforward control which 
can produce this output. The intuitive idea for the feedforward control in flexible joint robot 
control is that the joint spring is wound up in anticipation to the desired link motion rather 
than the desired motor motion. 

The feedforward design essentially involves an inverse plant problem. Consider the fol- 
lowing simplified model for a flexible joint robot: 

M{e t )9 t + C(6 t A)e t + Nk{N9t-9 m ) + T t {0 t ) = 0 (41) 

J m 9 m + D m 9 m - k(N9( - 9 m ) + T m (9 m ) = t. (42) 
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Figure 9: Inverse Joint Spring Function 

Given the desired Ot de9 (t) (which means all of its higher derivatives can be calculated), the 
desired 0 mde3 can be solved from (41) 

+ C(6 t , + T t (i) c )) + Nt) td „ (43) 

where A: -1 is the inverse function of the nonlinear joint spring (see Fig. 9): 

l( f (z. - (T& - K G A)sgn(x i ))K G ~ 1 |x,| > 

1 “ { A^/J : sgn(x t ) M < T a 

Higher derivatives of the desired motor angle, 0 mdes , can be obtained by directly differenti- 
ating (43). The feedforward control is then 

Tff = JmQm dc , + D m e mdcs - k(N$( des - e md J + T m (9 m ). (44) 

The calculation of 0 mdea and 0 mdea requires higher derivatives of Of and which in turn 
depend on higher derivatives of Coulomb friction and k~ l which are unbounded functions. 
Since the arm is anticipated to move very slowly, a reasonable approximation can be made 
by dropping higher order terms in and 9id*s (and higher derivatives). This then leads to 
a simplified expression for the desired motor angle: 

<W, = (45) 

This still leads to complicated expressions for higher derivatives of 0 mdca which are required 
in the feedforward control. We make a further approximation for 0 mdea by dropping the gear 
contribution in the derivative of 0 mdta . This approximation is plausible since the second term 
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in (45) usually dominates the first term, but it does not have a firm theoretical justification 
at the present (it is a major part of the future work): 


= N9 t 


The feedforward control then becomes 


T SS — JmN0t dca + D m N9( drs — k(i\9 (dcs — ^ d(j ) + T m (9 m ). (47) 

where 9 mdrs is given by (45). This feedforward is reasonable to implement in real time since 
no higher derivatives of 9 mdcs is used. 

So far, direct link coordinate measurements have not been used. To further enhance 
the performance of link responses, an additional modification of the feedforward control, 
motivated by [21], is made. The open loop desired link angular response 9 tdcs is replaced by 
a desired feedback control for the robot links, i.e., define the desired closed loop link angular 
acceleration by 

= »<„„ - K r ,(6 t - 6 ld „) - K„(9, - ih d J. (48) 

Then the expression for 0 mdt9 becomes 

Qm ies - j^k~ 1 (M(9 t )ai des + T e (9 e )) + N9e des (49) 

The same approximation of the higher derivatives of 9 mdcs is used as in (46), so the feedfor- 
ward torque is still given by (47) (using 9 mdes from (49). In all the simulation results in the 
next section, M(9() in (45) is further approximated by M(9t des ) which is easier to implement 
in real time (perhaps by table lookup and interpolation). The PD type of feedback for the 
link in (48) can be replaced by higher order positive real filters. This possibility has not 
been explored yet. 

The above scheme for computing the feedforward also affects the feedback servo loop since 
9 mdza and 9 mdr< are used in the feedback control law. In contrast, in the RMS controller, 9 mdt3 
is given by 9 mdrs = N9 ( d e> . Consequently, the motor response may be satisfactory but the 
link response is not. In effect, the modified scheme we have presented allows the joint spring 
to be wound up just right so spring torque emulates a link feedback control law (i.e., as if 
the link is feedback controlled by the spring torque). Furthermore, since the mass matrix is 
incorporated in the link feedback control law in (49), the interlink coupling is compensated, 
and the gains I\ pt and K V( can be tuned for each individual link. 


High Frequency filter 

Several high frequency filters have been tried beside the RMS high pass filter in (40). 
The first is also a high pass filter (the one used in the original SPAR report [17]) and it is 


positive real (i.e., passive): 


Hi(s) 


Kjs 

TlS + 1 


The second is a bandpass filter which is also positive real: 


H 2 (s) = k 


M 

a(s) 
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where k = 10E5 is the high frequency gain, b and a are both monic polynomials with roots 
of b at (0.5,70, 125) and roots of a at (50, 100,200,300). Simulation results of using different 
filters are not included in this report. However, we have observed that different filters lead 
to very different transient responses, especially in terms of the amplitude of oscillations. A 
systematic tuning procedure, perhaps based on some performance optimization criterion, 
will be investigated as part of the future work. 


Command Trajectory Smoothing 

Beside the step rate command, several other smoothed rate command trajectories have 
been used, including ramped velocity, exponential, and ramped acceleration. The conclu- 
sions drawn about the performance is similar for these three cases, and only the ramped 
velocity result is included in this report. The desired link angle, angular velocity, and an- 
gular acceleration for the ramped link velocity case are given below (the Cartesian case is 
identical): 


*<*.(*) 


~T’ i 2 + ^(°) 

e t/ (t-T) + d t (0)+kl 


f 6e,T t < T 
\ h, t >T 

| ^ t < T 
{ 0 t > T. 


t < T 
t > T 


(50) 

(51) 

(52) 


We shall see in the next section that, not surprisingly, the ramped velocity profile produces 
much less uncommanded motion and oscillation, and improves the settling time at the same 
time. This is true for both the existing controller and the modified controller, but the 
modified controller tracks much more closely. The contrast between the performances of 
the two controllers is most evident during the initial stage where the motor torque needs to 
overcome stiction to cause link motion. If only motor feedback is used, there is an initial 
delay where enough motor error needs to accumulate before the control torque becomes 
greater than the stiction. With the feedforward, link error causes the joint spring to wind 
up faster, leading to a much reduced delay. 


5 Comparison of Controllers 

In this section, we will compare the performance of the RMS controller versus our proposed 
controller for the following cases: 

1. End effector step response for the unloaded and loaded cases. The command is a rate 
step along one of the coordinate directions (x, y, and 0) at the following rate limits: 


Variable 
x rate ( m/sec) 
y rate ( m/sec) 
0 (rad/sec) 


Unloaded Baseline payload 
0.36576 0.03048 

0.36576 0.03048 

0.040 0.003 
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Due to the velocity limiting logic, the rate command may be modified. 

2. End effector response in loaded and unloaded cases for a ramp rate command. 

We will compare the response in terms of the following measures: 

1. Uncommanded motion. This is measured in terms of the peak and steady state position 
and velocity deviation in the uncommanded variables, which in the joint case are the 
uncommanded joints and in the end effector response case, they are the uncommanded 
coordinate directions. 

2. Transient response. This is measured in terms of the settling time and overshoot of 
the commanded variable. 

3. Steady state response. This is measured in terms of the steady state velocity and 
position tracking error for the commanded variables. 

Additional considerations that should be taken into account in the performance compar- 
ison include: 

1. The torque limit is removed in some runs to indicate the effect of saturation. In most 
cases, the performance degrades only slightly. However, a systematic method to avoid 
saturation is an important topic that will be investigated in the future. 

2. The closed loop performance depends heavily on the choice of gains. At the present, 
no extensive tuning has been performed. 

3. In simulating the proposed controller, the feedforward is approximated to somewhat 
address the robustness and implementation issues. A rigorous investigation of the 
robustness issue needs to performed in the future. 

4. In the simulations for comparing the two controllers, we have removed the hysteresis 
effect (i.e., dependence of torque limits and motor efficiencies on velocity) to obtain a 
baseline comparison (so there will not be too many variables to cloud the interpretation 
of results). Simulation using the full nonlinear model is currently underway. 

Loaded Case 

We first compare the step end effector velocity responses. The arm is initially in the 
following configuration: 


6 t (0) = [-0.6242, 1.3002, -0.6260] T rad (53) 

with 0 m (O) = 0,(0) * N (iV is the gear ratio). This configuration corresponds to the end 
effector location 

x(0) = 13.469m, y( 0) = 0.39m, 0(0) = O.OSrad. (54) 

The configuration is shown in Fig. 10. The nominal command is a step of 3E-3rad/sec in 9 
for lOsec and drops to zero after lOsec. Due to joint velocity saturation and velocity limiting 
logic, the actual commanded rate is slower. Fig. 11 shows the arm response with the RMS 
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Figure 10: Initial Configuration 

controller and Fig. 12 and Fig. 13 show the responses under the modified controller with two 
different sets of gains. The first set uses the existing RMS motor feedback gains and low link 
feedback gains (for all joints): 

Gain 1: K Pe = 1 K Vt = 2 k p = . 1764 k v = 3.53, (55) 

The second set uses higher motor proportional gain and lower derivative gain, and higher 
link feedback gains: 

Gain 2: I< Pt = 5 K V( = 4.5 k p = 4 k v = .1. (56) 

As seen clearly from these plots, the modified controllers exhibit all around superior per- 
formance (in terms of the stated measures) over the RMS controller. Within the modified 
controller, the higher gain case performs much better. It should be emphasized that high 
gain is not the reason that the modified controller outperforms the RMS controller, the key 
is in its ability to wind up the joint spring based on the link angular error. In fact, when 
gains in the RMS controller are increased, the performance actually degrades. It is perhaps 
not surprising that modified controller demands much more command torque than the RMS 
controller. The large torque, however, only last over a small period of time since the error 
is reduced very quickly. When torque saturation is imposed, the response (shown in Fig. 
14) is still quite good. There is slightly more rotational velocity oscillation during the initial 
step command, but the uncommanded motion and steady state error are much improved 
over the RMS controller case. Simply clamping the input at the saturation level clearly is 
not the best solution; for example, it may be advisable to reduce the commanded velocity 
when input saturation occurs. When saturation level is exceeded by a large amount or for 
an extended period of time, then direct clamping may lead to instability, for example, see 
the commanded y case in Fig. 23. A systematic solution to the saturation issue is a key item 
for our future research. 
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Figure 11: Step 9 Velocity with RMS Controller 
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Figure 12: Step 9 Velocity with Modified Controller (Gain 1) 
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Figure 13: Step 9 Velocity with Modified Controller (Gain 2) 
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Figure 14: Step 9 Velocity with modified controller (Gain 2) and Torque Saturation 
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Figure 15: Initial Configuration 

Comparison between the performances of the RMS controller and the modified controller 
is even more striking with another initial condition: 

0*(O) = [0, 0.05, 0] T rad (57) 

This configuration is shown in Fig. 15. The response of the RMS controller is shown in 
Fig. 16, and the response of the modified controller is shown in Fig. 1 7 . The gains used in the 
modified controller is relatively low: 

Gain 3: I< Vt = .25 I\ V( = 1 k p = 1 k v = . 1 . (58) 

Figures 18, 19, 20 show responses of the arm with an x direction rate command, under 
the RMS controller and the modified controller with gains as in (56), with and without 
saturation. Figures 21, 22, 23 show responses of the arm with an y direction rate command. 
The initial condition for all cases is (53). With the modified controller, the uncommanded 
motion and steady state error are virtually eliminated, and the transient response (in the 
unsaturated case) is also better. Even with saturation, the commanded rate overshoot is 
slightly larger than the RMS case, but the position error is much smaller. The only exception 
is for the step commanded in y. In Fig. 22, the saturation level is exceeded by a large amount, 
and direct saturation of the control signal leads to major degradation of performance in 
Fig.23. 

To demonstrate the impact of trajectory shaping, we consider a ramp velocity profile 
instead of a step. The ramp up takes the first lOsec, beyond which the velocity stays at a 
steady state value (at the same level as the step cases). The responses for the RMS arm 
versus the modified arm (with gains (56)) for 9, x, and y rate commands are shown in Figures 
24-29. As expected, for both controllers, the responses improve over the step command cases. 
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Figure 16: Step 6 Velocity with RMS Controller 
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Figure 17: Step 6 Velocity with Modified Controller (Gain 3) and Torque Saturation 
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Figure 18: Step x Velocity with RMS Controller 
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Figure 19: Step x Velocity with Modified Controller (Gain 2) and without Torque Saturation 
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Figure 20: Step x Velocity with Modified Controller (Gain 2) and with Torque Saturation 






voltage (V) translatjonal velocity (m/sec) displacement (m) orientation (rad) 








time (sec) ^ e . X-displacement (m) 

Figure 21: Step y Velocity with RMS Controller 
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Figure 22: Step y Velocity with Modified Controller (Gain 2) and without Torque Saturation 
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Figure 23: Step y Velocity with Modified Controller (Gain 2) 
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The modified controller again outperforms the RMS controller by all measures. Furthermore, 
the input is no longer saturated. This demonstrates a promising direction to pursue for the 
saturation problem: filter the input command (i.e., slow down the commanded trajectory) 
until the input is out of saturation. This will be described further in the next section. 

Unloaded Case 

When the arm is unloaded, the inertia of the last link is two orders of magnitude smaller 
than the first two links. As a result, the response tends to be more oscillatory (especially in 
end effector orientation). The oscillation is usually very noticeable in 9, but because of the 
link inertia, the effect is small on the orientation 9 (especially for high frequency oscillations). 
We will first show the arm responses with the RMS controller and the modified controller 
with step 9, i, y, responses, respectively: The plots are shown in Figures 30-35. The initial 
condition is chosen to be (53) and the gain for the modified controller is given by (56), 
which is the same as the loaded case (gain adaptation based on payload is not considered 
here). Input saturation is imposed in all cases. By all performance measures, the modified 
controller clearly outperforms the RMS controller. 

Arm response for a ramp command velocity input is showm in figures 36-41. The contrast 
between the two controllers is even more pronounced. The modified controller exhibits a 
high frequency oscillation in 9 which is almost undetectable in 9 due to the link inertia. 
This oscillation is likely caused by the feedback gains which are tuned for the loaded case. 
A systematic method for selecting the gains, k p , k v , K Pt , and K„ t , will be developed in the 
future. 

General Observations 

Based on voluminous simulation data (only a small portion of which is shown here), we 
can make the following general observations on the comparison between the RMS controller 
and the modified controller: 

1. The RMS controller is simpler in structure. The modified controller requires more 
model information (mass matrix, friction, and joint spring characteristics) and more 
on-line measurement information (link angle and angular velocity). 

2. For the RMS controller, commanded velocity tends to undershoot its set point due to 
its relatively low gain. As a result, the link position almost always lag w T ay behind the 
commanded trajectory. For the modified controller, since the proportional gain (for 
both link and motor) is higher, there tends to be more velocity overshoot. However, 
the positional response is in general much better than the RMS controller case. 

3. Almost in all cases involving the modified controller, link velocities overshoot their set 
points. This is due to the fact that in order for the link angle to catch up with the 
desired trajectory, link velocity has to exceed its set point to compensate for the initial 
lag (due to friction). An important consideration in choosing the feedback gains is in 
deciding which one of the responses, link angular velocity or angular position, is more 
important to the operator. The gains should then be selected accordingly to emphasize 
that variable. 
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4. If the input torque is not explicitly clamped at the saturation level, the modified 
controller tends to require very large input over a short period of time during the 
step response (when the error is large). With saturation, the performance degrades 
somewhat, but is usually still quite satisfactory. Even though the saturation does not 
seriously affect performance in most cases, it is desirable to have a safety mechanism 
to guard against saturation. We are developing a command trajectory modification 
algorithm to explicitly address this issue. As a preliminary check of this idea, when 
the commanded velocity step is slowed to a ramp, saturation no longer occurs. 

5. The same set of gains (56) has been shown effective for both loaded and unloaded case. 
A systematic tuning of gain should be developed in the future. 

6. We have noted that to improve the performance for the modified controller, motor 
feedback gains have to be increased together with the link feedback gains. This is due 
to the fact that a tight motor loop is required so that the spring torque can closely 
emulate the desired link feedback control law. 
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Figure 25: Ramp 6 Velocity with Modified Controller (Gain 2) and with Torque Saturation 
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Ramp x Velocity with Modified Controller (Gain 2) and with Torque Saturation 
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Figure 28 : Ramp y Velocity with RMS Controller 
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Figure 29: Ramp y Velocity with Modified Controller (Gain 2) and with Torque Saturation 
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Figure 31: Step 9 Velocity with Modified Controller (Gain 2) and with Torque Saturation 
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Figure 32: Step x Velocity with RMS Controller 







8 0.1 
1 

8 


W 0.05 


13 

§ 

cd 


- 0.05 


r 

ft , 

r 

Hr- f 


10 


20 


time (sec) 


time (sec) 




Figure 33: Step x Velocity with Modified Controller (Gain 2) and with Input Saturation 
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Future Work 


The research results presented in this report shows the efficacy of the passivity approach 
in the control of flexible joint robots with massive links, such as the shuttle RMS arm and 
the anticipated space station arm. As stated in the introduction section, several assump- 
tions have been made in the model to simplify the analysis. These assumptions need to 
be placed on a rigorous theoretical footing. In addition, performance optimization criteria 
should be included in the feedback gain selection, and the improved performance should be 
demonstrated experimentally in some form. Based on these considerations, we propose the 
following agenda for the future tasks: 

1. Observer for link variables: Existing RMS controller only uses motor angular velocity 
feedback (motor angles are derived from motor velocities). The most effective form of 
the modified controllers requires link angle and angular velocity feedback. We will de- 
rive nonlinear observers (most likely only including nonlinearities such as mass matrix 
and Coulomb frictions, while ignoring Coriolis and centrifugal terms) to estimate the 
link variables based on the motor variable measurements. 

2. Saturation Avoidance: When the velocity or the command torque are too high, they 
become saturated. In the existing RMS controller, there is already a commanded 
Cartesian velocity modification algorithm if the joint velocity becomes saturated. We 
will also apply the trajectory modification technique for the torque saturation, such as 
the method proposed in [22] (slowing down the commanded trajectory until the arm 
is out of the saturation condition). 

3. Robustness Analysis: The feedforward that has been proposed involves some assump- 
tions to simplify its expression (c.f. section 4). A rigorous stability analysis (most 
likely a local analysis) needs to be performed to justify this simplification. Even after 
simplification, the feedforward still requires considerable amount of model information, 
including mass matrix, link and motor frictions, and joint spring characteristics. Errors 
in this information needs to be evaluated in terms of stability and performance. 

4. Optimal Feedback Tuning: We have seen that there is considerable leeway in choosing 
the motor rate feedback and this choice can significantly affect the transient perfor- 
mance. A systematic method of designing this feedback based on performance con- 
siderations need to be developed. A possibility is to apply a parameter optimization 
approach based on, for example, settling time, overshoot, etc. 

5. Experimental Validation: To truly validate the effectiveness of the proposed approach, 
implementation and demonstration on a physical arm should be performed. As a first 
step in that direction, we propose to implement the proposed control algorithms on 
the simulated RMS arm at JSC. 

7 Conclusion 

In this report, we have presented a general theory for the stabilization (vibration suppres- 
sion and disturbance rejection) and output tracking of flexible robots. This theory includes 
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Figure 34: Step y Velocity with RMS Controller 
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Figure 35: Step y Velocity with Modified Controller (Gain 2) and with Input Saturation 









voltage (V) translational velocity (m/sec) displacement (m) orientation (rad) 






EE Y-Velocity 




0.395 


0 10 20 
time (sec) 

EE locus 



0.392 


13.467 13.468 13.469 13.47 

file: nlfilel4 X-dispIacement (m) 

Figure 37: Ramp 8 Velocity with Modified Controller (Gain 2) and with Input Saturation 







0.052 


EE Orientation 


14 


EE X-Displacement 


'l 0.052 


1 0.051 



10 

time (sec) 

EE Y-Displacement 



10 

time (sec) 



0 10 

time (sec) 

xHE^otational Velocit 



file: nlfile4 


10 

time (sec) 


EE X-Velocit 



0 10 2C 

time (sec) 

2 Motor Command Voltage 

| l 

1 KsTjR’ii 


8 0.03 

f 

5 0.02 

6 

| 0.01 

4 0 

e 

| - 0.01 
I -0.02 


EE Y- Velocit 



e 

o 

E „ , 
8 0.4 

«3 

y 0.395 
>- 


10 

time (sec) 
EE locus 



0 10 20 8 10 12 

time (sec) fi j e; nlfile4 X-displacement (m) 

Figure 38: Ramp x Velocity with RMS Controller 
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Figure 39: Ramp x Velocity with Modified Controller (Gain 2) and with Input Saturation 
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Figure 40: Ramp y Velocity with RMS Controller 
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Figure 41: Ramp y Velocity with Modified Controller (Gain 2) and with Input Saturation 





w 


flexible joint robots as a special case. The structure of this family of controllers consists 
of a passivity based feedback and an inverted plant based feedforward. Through extensive 
simulation on a three-link test arm modeled after RMS shoulder yaw joint, we have demon- 
strated the efficacy of this approach as compared to the existing RMS controller. Future 
task includes observer design, saturation avoidance, robustness analysis, optimal feedback 
tuning, and experimental validation. 
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APPENDIX 

A General Theory 

A.l Mathematical Background 

The time evolution of ‘energy’ is an important and useful characterization of stability for 
physical systems, linear and nonlinear alike. Energy based stability analysis has been widely 
applied to the study of systems such as electrical networks, mechanical structures, thermal 
systems, etc [23]. The concept of passivity is traditionally defined as an input/output (I/O) 
condition [24] describing a common class of physical systems which do not generate energy. 
Relationship between I/O passivity and state space parameters was extensively explored in 
the 60’s [25] in part by using the Lyapunov’s method. In this section, we will summarize 
some basic definition and results that will be useful for the rest of the paper. 

Define the input and output signal spaces, U e , X» respectively, as extended spaces 
T2e(R-+ 1 R- m ). Let Pj denote the operator which truncates a signal at time T. Define 
the truncated inner product by 

{v()A-))t = Pt «(.)) 2 = P(PMt)) T PMt)dt. 

Jo 

By a dynamical system, we mean an I/O mapping FI :U e — » X- The input-output stability 
considered here is the finite-gain I/O stability. A system H is said to be finite-gain I/O 
stable if there exists a constant k such that 

\\P T y\\<k\\P T u\\ for all T > 0. 


H is passive if 


(y, u) T > 0 for all T > 0. 
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The concept of passivity can be generalized to dissipativity [26]. A system H is dissipative 
with respect to the triple ( Q,S,R ) if 

(y, Qy)r + 2 (y> Su )t + ( u > Ru )t - 0 

for all T > 0 and u £U e , where Q , S and R are memoryless bounded operators with Q and 
R self-adjoint. Clearly, a finite-gain stable system is dissipative with respect to ( — I,0,k 2 I), 
while a passive system is dissipative with respect to (0,^/,0). 

An important theorem which can be used to determine the I/O stability of the intercon- 
nection of passive systems is the Passivity Theorem. In its simplest form, it states that if the 
open-loop system is passive and the feedback system is strictly passive, then the closed-loop 
system is Z 2 -stable i.e. finite-gain I/O stable. 

I/O stability infers internal state space asymptotic stability if the closed-loop system is 
stabilizable and zero-state detectable (if these properties hold globally, the internal stability 
is also global). A system H is said to be zero-state detectable if u(t) = 0 and y(t ) = 0 
imply that the state x(t) = 0. For linear systems, this corresponds to observability. Under 
the stabilizability and detectability conditions, a dissipative system with Q < 0, i.e. a finite 
gain I/O stable system, has an asymptotically stable equilibrium at zero. Sometimes, it is 
possible to show via a Lyapunov type argument y(t) — > 0 if u(f) = 0. Then the zero-state 
detectability alone guarantees internal asymptotic stability. 

A. 2 Main procedure 

The general class of systems considered in this report is described by the following dynamical 
equation of motion: 

M{9)6 + D(0) + C(9, 0)9 + f(0) = Bu (59) 

where 6 G R n is the displacement vector, u G R m is the input force vector, M is the mass- 
inertia matrix, D is the damping, C corresponds to the centrifugal and coriolis forces, and 
/ contains the gravity force, spring coupling force, friction, etc. 

Most mechanical systems belong to this class; additional assumptions will be imposed 
later as required. Particular systems of interest that can be considered include fully ac- 
tuated robots, flexibly jointed robot, robots with flexible links, and satellites with flexible 
appendages. For the general discussion, we assume zero damping, i.e., D(9) — 0. All the 
results are of course valid for the damped case also. 

We will first consider the output set point control problem. 

Assume the measured outputs are B T 0 and B T 9 , i.e., the generalized coordinate and velocity 
that are directly actuated. Suppose the output of interest is 

y = C9. (60) 

Choose a feedback control law u based on the measured output, so that y(t) asymp- 
totically converges to the desired output set point y des . 

Based on the inherent passivity property of this class of systems, the general procedure 
described below can be used to construct a solution to the output set point control problem. 
Extension to output tracking will be addressed in Section A. 6. 
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1. Steady State Analysis. The first step is to find a desired state 9 des and a feedforward 
ujj such that 

COfies = Udes (61) 

Bujj = f(9 des ). (62) 

If these equations are solvable, then the feedforward control can be used to form the 
error system: 

M{9)9 + D{9) + C(9, 9)9 + f(9) - f(9 des ) = Bu 0 

where u = u a + u jj. 

2. Error system Stabilization. Assume that with a static feedback u 0 = g(B T 9 ), 
the map from u 0 to B T 9 is passive (this assumption will be justified for a number of 
applications). Then any strictly passive map from B T 9 to u 0 can be used to feedback 
I/O stabilize the error system. If the closed loop system is further stabilizable and 
zero-state detectable with respect to u a and B T 9, respectively, then the zero error 
state is asymptotically stable. 

We will focus on three examples, flexibly jointed robots, flexible beams, and fully actuated 
robots, to demonstrate the application of the above simple approach. 

Remarks: 

1. If the system is linear, then the passivity of the original system (between u and B T 9) 
implies the passivity of the error system (between u Q and B T 9). For nonlinear systems, 
additional assumption on / needs to be placed, for example, the joint flexibility is 
sufficiently strong relative to the gravity load for flexibly jointed robots. 

2. It is well known that passive linear systems are necessarily minimum phase and, con- 
versely, a minimum phase plant can be rendered passive through a static state feedback. 
A similar relationship for nonlinear systems has also been recently published [27], It 
is shown that a nonlinear system can be rendered passive by static feedback (i.e., it is 
feedback equivalent to a passive system) if and only if the zero-dynamics are weakly- 
minimum phase and the relative degree is one. It is known that flexibly jointed robots 
and flexible beams have stable zero-dynamics with respect to the motor velocity and 
hub velocity, respectively. We will show that the static position feedback renders these 
systems passive. 

3. The classical proportional-derivative (PD) control law (for the actuated variable) is 
a special case of the family of control laws developed here. However, the velocity 
feedback can be augmented by any passive system in parallel. Through an example, 
we will see that the dynamic nature of the passive system can be exploited to enhance 
the closed-loop performance. 

4. As it will be shown in the application examples in sections to follow, the above analysis 
does not require any structural damping in the model. Damping, however, will be useful 
in the output tracking problem. 
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A. 3 Application to Flexibly Jointed Robots 


Consider the general model for an n-link flexibly jointed robot (2 n degrees of freedom) [28]. 
This model contains the gyroscopic forces that are commonly assumed approximately zero 
[29, 30, 31]. Denote the link angle vector by 9g and motor angle vector by 6 m . Define 
0 = \ 0g T 9 m T | T . The dynamic equation of motion is given by 


where B is of the form 


0 


M{6)6 + C(9, 9)9 + g{9) + k{9) = Bu 

I 


(63) 


T due to the assumption that only motor shafts are actuated, 
g(9) denotes the gravity load, and k{9) denotes the spring coupling between motor shafts 
and the link shafts. 


A. 3.1 Feedforward Compensation based on Steady State Analysis 

The control objective is to steer 6( to some desired constant Qt dca (i-e., in (60), y = 9 ( ). The 
first step is to form an error system: 

M(9)9 + C(9, 9)9 + g(0) - g(9 des ) + k(9) - k(9 dea ) = Bu - g(9 dea ) - k(9 dea ). (64) 


In order to cancel the additional terms on the right hand side, we need to find a feedforward 
torque ir^-and a desired set of angles 9 des (as in (61)— (62)) that satisfies 

u - u 0 + uff (65) 

Bug = g(6 dea ) + k(9 des ). (66) 

Equation (66) can be restated as follows: for a given Vi.,, find 9 mde3 and u^such that 


0 = B(g(9 des ) + k(9 des )) (67) 

u ff = (B T B)~ 1 B T (g(9 des ) + k(9 des )) = B T (g(9 des ) + k{9 ies )) (68) 


where B is the annihilator matrix for B, i.e., BB = 0 or £ = | / 0 J . The terms g(9 des ) 
and &(0des) are usually in the form 


diodes) 


k{@des) 


0 

— &l(^ d£3 ) @m dea ) 


(69) 

(70) 


This implies that u^-and 9 mics should satisfy 

Uff = gi(9e d J 

md'„0 md J = -gi(9e d *,)- 


(71) 

(72) 


To solve (72), we assume that for a given 0 (dc3 , Ve m ki(9( dta ,0 m ) is invertible in some open set 
in 9 m . Then by the Implicit Function Theorem [32], there exists a locally unique solution 
to the equation (72). A common form of k x is 


0 k l ),(0 e ,9 m ) = f(N l 9 ei -9 mi ) 
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where Ni is the gear ratio of the ith joint and / is monotonically increasing, continuously 
differentiable, and the range of / is R. In that case, since / is globally invertible, a unique 
solution, 0 mde3 , to (72) can be found for any 9t dea - 

A. 3. 2 Passivity 

With the desired motor angle and feedforward torque chosen as in (71) and (72), the equation 
of motion becomes 

M (0)9 + C(8, 9)8 + g(9) — g(8 c i es ) + k(9) — k(9 dea ) = Bu 0 . (73) 

If the sum of the gravitational potential energy and spring potential energy is positive 
semidefinite in A 9, A 8 = 8 — 8 dea , then one can show that the map from u Q to 9 is passive. 
This is not true in general since 0t dra can be arbitrarily chosen. Therefore, we introduce an 
artificial potential energy by using a proportional feedback in u 0 \ more specifically, choose 
u 0 to be 

u 0 = u\ — K P B T A8. (74) 

Assume that it is possible to choose K p so that for some <5 > 0 

V $g(9 dea ) + V $k(9 dta ) + BK p B t > 51 > 0. (75) 

Consider g(8) and k(9) as modeled by (69) and (70), respectively, where k x is 

kx(9 e ,9 m ) = f(N8 e -8 m ) (76) 

/ is a monotonically increasing function and N is a diagonal matrix containing the gear 
ratios. Then condition (75) becomes 

o] r Nvnm,^ i r o oi 

0 j + | -NVf(N0 ld „ - e md J Vf(N9 ld " - »„J) J [ 0 Kp J > U 

(77) 

If the spring at the joint is sufficiently stiff in the sense that 

AW/( N6 tdd , - 6 md J > (78) 

then condition (77) is satisfied for a sufficiently large K ? . 

Now consider the following scalar function 

V(A 9,9) = U t M(9)9 + U(A9) 

where the first term on the right hand side is the kinetic energy and the second term is the 
sum of the potential energies: 

U(A8) = G(A0 + 0 des ) - G(8 des ) - g(0 de ,) T A9 + K(A9 + 9 des ) - I<(9 des ) 

-k(9 dea ) T A8 + i A9 t BK p B t A9 (79) 
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where G and K are the gravitational and spring potential energies, respectively. Under the 
assumption that (75) is satisfied, U(A9) is positive definite. The derivative of V along the 
solution of the equation of motion, denoted by V, is 

V = i> T Bui (80) 

where we have used the fact that C(8,0 ) can be chosen (only C(9,9)8 is unique, but C(6,6) 
is not) so that ^ M — C(0,9) is skew symmetric (a fact that was used in [2, 33, 4, 5, 21] and 
many others). Integrating both sides of (80) and using the fact that V is positive definite, 
it follows that the map from u x to B T 9 — 9 m is passive. 

A. 3. 3 Stabilization 

Once the passivity from iq to B T 9 is established, a large family of feedback control law can 
be used to achieve I/O stability: 

m = u 2 — C v (B t 9 ) (81) 

where C v is any strictly passive system. Since the closed-loop system is the feedback connec- 
tion of a passive system and a strictly passive system, by the Passivity Theorem, the map 
from u 2 to B t 9 is Z^-stable. Furthermore, if u 2 — 0, we can conclude from (80) and the 
Invariance Principle that (9,9) converges to the largest invariant set in {(9,9) : B T 9 = 0). 
To see this, recall that the strict passivity of C v means 

/ w T C v (w) dt > — y 2 + r) f ||u;|| 2 cft. (82) 

Jo Jo 

for any w € L 2c . Substituting B T 9 into w, and noting that the left hand side of (82) asymp- 
totically vanishes due to (80), it follows that B T 9 € L 2 . Now by applying the standard 
argument that 0 are uniformly bounded, we can conclude B T 9 —* 0 asymptotically. Fur- 
thermore, since all higher derivatives of 9 are uniformly bounded, all higher derivatives of 
B T 9 also tend to zero asymptotically. If the closed loop system is zero state detectable from 
B t 9 , then the zero error state is asymptotically stable. If the detectability is global, then so 
is the asymptotic stability. 

Under the following assumptions (slight generalization of the conditions in [10] and in- 
cluding the approximate model in [29] as a special case), the zero state detectability can be 
shown: 

1. The mass matrix M is of the special form 

' Mn(9() Mn(9() 

M\2 T(8i) M 22 

This assumption is valid when the motor is symmetric about its axis of rotation; 
otherwise, all four blocks would depend on both 9 t and 9 m [34]. 

2. The gravity load g and elastic coupling k are given by (69) and (70). 

3. k is diagonal (i.e., k, only depends on 0 ti and 9 mi ). 
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4. Vg t k(Ot, 9 m ) is positive semi-definite for all ( 9 e and 0 m , and (0 f , 9 m ) for which Vs t k(9 e , 9 m ) 
loses rank are discrete. 

To see how this set of assumptions lead to detectability, substitute 9 m = 0 into the dynamical 
equation (59), then we have 

M n (9 e )9 e = —Ci(9t,9e)9e — gi(9() + gi(9e dc3 ) — ki(9i,9 m ) + k l (9e des ,9 mdt3 ) (83) 
M\2 T (9()9( = ki(0(, 9 m ) — ki(9( dea , 0 mdt3 ) — K p A9 m . (84) 

Differentiate (84) once more, we have 

M u T (9 e )h — Vg t ki(9(,9 m )9{. 


It has been independently pointed out in [34] and [10] (the former is for the exact case) that 
Afi 2 is strictly upper triangular. By assumptions 3 and 4, 9( — 0. Substituting back into 
(73), we obtain 

g(9)-g(9 des ) + k(9)-k(9 des )-K p B T A9 = 0. (85) 

From the assumption that I\ p has been chosen sufficiently large as in (75), (85) implies local 
asymptotic stability. If (75) holds uniformly for all 9 des , then the asymptotic stability is in 
fact global. 

For the general model, the observability condition can be checked for the linearized 
system. First set U 2 (t) = 0 and B T 9(t) — B T 9(t ) = 0. From linearized closed-loop equation 
of motion, we have 

B T M{9 des )- 1 (V e g(0 des ) + V 8 k{0 des ) + BK P B T )A9 = B T M{9 des )-'I<A9 = 0 . 
Differentiating this equation twice more and use the equation of motion again, we have 

B T M(9 des )~ 1 K9 = 0 
B T M(9 des )- 1 KM{9 des )~ 1 KA9 = 0. 

These equations together imply the full state is identically zero if and only if M(9 des ) — K 
is nonsingular, where K = V gg(9 des ) + V $k(9 des ) + BK P B T . 

From the above analysis, it is clear that under fairly mild conditions, the zero error state 
of the closed-loop system is globally asymptotic stable. But which C v should one choose 
among the many possibilities in order to enhance a specified performance measure? This 
appears to be a hard question in general. We shall again encounter the same question in the 
next section. At the present, we do have some intuitive rules of thumb for the selection of 
C v . The simplest choice of C v would be just a constant gain. Then the closed-loop control 
law is of the PD type (but only the motor variables are fed back). As demonstrated in 
simulation in [1], in contrast to the fully actuated robots, large PD gains degrade the closed- 
loop performance in terms of the settling time and amplitude of oscillation. This is due to 
the fact that the zeros in the to 9 m system are on the ju- axis, high gains would then drive 
some of the poles toward these zeros and the response would become increasingly oscillatory. 
It is intuitively plausible to choose C v to be an SPR (i.e., linear time invariant and strictly 
passive) compensator where the gain is concentrated at the open-loop resonant frequencies 
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(so that a small oscillation in 9 m will cause large a corrective action) and at the disturbance 
frequencies (as in notch filters). In simulation [1], much improvement is obtained by using 
this approach. This idea is similar to a common practice in servo control where a band 
pass or high pass filter is used in the motor velocity loop (usually analog), in addition to 
the usual PID loop, to improve performance in the higher frequency range (for example, see 
the servo controller for space shuttle remote manipulator system in [17]). For the type of 
systems considered here, we can be more specific about the class of filters that can be tuned 
for increased performance with affecting the stability. 

In the feedforward, the only model-dependent information that is required is the grav- 
ity load and spring coupling. If this information is inexact, then u 2 in (81) is a nonzero 
constant. Since local internal asymptotic stability implies bounded-input/bounded-output 
(BIBO) stability for sufficiently small initial error, the output error 9 e — 9( des is also propor- 
tionally bounded, and the internal states would remain bounded. In Section A. 7, we will 
adaptively update this constant; not surprisingly, the resulting control law is of the standard 
proportional-integral-derivative (PID) structure. 

In the case that the full state is available, an interesting question arises: How can 9( and 
9f be included in this passive control framework? A reasonable approach would be to find 
another output which is independent from 9 m and passive with respect to u 2 (i.e., after the 
A 9 m and 9 m loops have been closed as described above). Then an additional strictly passive 
feedback can be applied to enhance transient performance. Finding an additional passive 
output for a linear system of the form x = Ax + Bu is straightforward: solve the Lyapunov 
Equation A T P + PA + Q for some Q > 0, then choose the output map to be C = B T P. A 
general procedure for nonlinear systems such as the flexible joint robots is unknown at the 
present. 

A. 3. 4 A Simplified Dynamical Model 

The exact model for flexibly jointed robots is not exact linearizable [35], In [29], a simplified 
model for flexibly jointed robots was proposed. This model ignores the gyroscopic forces due 
the motion of rotating motors in the inertial space. Based on this model, an exact linearizing 
control law was obtained. The simplified and full models have been compared in [28] based 
on the parameters of a PUMA 560 robot and it is concluded that the approximate model is 
a very good one for earth bound applications (when the arm is mounted on a mobile base, 
the effect is far more drastic). The space shuttle remote manipulator system is also modeled 
under this assumption [17]. In this subsection, we consider the stability analysis and control 
design discussed above as applied to this simplified model. 

The simplified model is of the form 

Mi{9()0( + Ci(9 ( , 9t)9t + 9i{9e) + k\(N9e — 9 m ) = 0 (86) 

I m L-h(N9 t -9 m ) = u. (87) 

Given the desired link angle vector t , the steps in section A. 3.1 can be followed to obtain 

the feedforward control u jj and desired motor angle vector 9 mdes for the error system: 

Uff = 9i(0e d J 

0m d " = N9 (de} -K'(- gi (9 (d J) 
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( 88 ) 

(89) 



where k x is assumed to be globally invertible. The spring model for k x is usually assumed 
to be diagonal (i.e., the ith component of k x (x) only depends on x;) and each component 
is monotonically increasing. Hence, the invertibility assumption on ki is a very reasonable 
one. 

The error system is described by 

+ Ci(6e, 9 ( )9 e + g x (9() — gi{9e dea ) + k x {N9( — 6 m ) — k x {N9t det — 9 mdca ) = @ 00 ) 
Im 'Om - ki(N0 t - 6 m ) + k l (N0( dci - 0 mdtt ) = U 0 ( 91 ) 

where u = u 0 + ujjha,s been used. As in section A. 3. 2, in order to show passivity, we introduce 
a proportional feedback to create a positive definite potential energy at the desired set point: 


U 0 — ll X 


> 0. 


(92) 


Now, assume 

+ N\7 g k x (N9 idt! — 9 mdas ) —V g k x (N9 tdci — 9 mdas ) 

-NV e k x (N0 (dea - 9 md J K p + V e k 1 (N9 (de) - 9 md J 

This condition is satisfied if the spring is sufficiently stiff compared to the gravity load 
(typically a reasonable assumption especially for geared robots) and K p is sufficiently large 
in the following sense: 

NVeki(N9 (d ej - 9 mdaa ) > ~^egi(9e de3 ) (93) 

N\\VMN9 ede! -9 md jr 

^min (Ap) > 7 v 

+ V.J, («,„,)) 

With the storage function 


-<?nnn(V9k l (N0 idea -d md j). (94) 


v = ^9e T Mi(0t)9t + l -L T lJm + U(A6 e , A 9 m ) 


(95) 


where 


U(A9 e ,A9 m ) = G x (A6 e + 9 (d J - G x {9 td J - 9l (6 (d J T A9 e 

+K 1 (NA9 i - A 9 m + N9 idca - 9 md J - K x (N9 tdea - 9 md J 

-k x (N0 (des - 9 md J T (NA9 e - A 9 m ) + l -A9 m T K p A9 m . (96) 

The scalar functions K x and G x are the spring potential energy and gravity potential energy, 
respectively. Again use the skew symmetric property of \M X — C x \ it follows that the 
derivative of V along the solution trajectory of (86)-(87) is 

V = 9jn x 


which implies that the map from u x to 9 m is passive. 

The final step is to choose a motor velocity feedback for stabilization. Again by the 
Passivity Theorem, u x can be chosen as 


u x -u 2 - C v (A9 m ) 

where C v is strictly passive, the closed-loop system is L 2 I/O stable from u 2 to A 9 m . 

Since the simplified model in this section satisfies all the assumptions stated in the last 
section, global asymptotic stability of the zero error equilibrium follows from the I/O stabil- 
ity. 
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A. 4 Application to a Single Flexible Link 

Consider the linearized model for a single link flexible link [36, 13] discretized in terms of 
the natural modes: 

q + Q, 2 q = bu (97) 

where q is the modal amplitude, u is the hub torque, and 


ft 2 


Ol x 1 Oj x n 

-Onxl dia gnXnK 2 }J ’ 


= i EV--i(o) i>',( 0 ) 

P 


#(0)I 


where p is the link density (over unit length), w.’s are the natural modal frequencies and 
ipi’s are the corresponding mode shapes. Spatial derivatives are denoted by ' . Here we 
consider only an (n + l)-mode approximation to avoid the technicality associated with 
infinite dimensional systems. For a discussion in the infinite dimensional context, see [13]. 
Note also that the nonlinear model in [13] is of the same form as (64) in the flexibly jointed 
robot case. The same analysis as in the previous section can be applied. Here we will 
concentrate on the linearized model. 

Let x = [ 9 , q] T . The state space equation is 


x = 


0 I 

-Q 2 0 


x + 



(98) 


Assume that the hub angle and angular velocity can be measured. The corresponding output 
equations are 


Vp = l bT 0]* (") 

Vv = [0 b T ]x ( 100 ) 


where y p and y v are proportional to the hub angular position and velocity, respectively. 


A. 4.1 Feedforward Compensation based on Steady State Analysis 

Suppose the output of interest is the scalar variable 

y = Cq. 

Consider the set point control problem of steering an arbitrary initial state (<?( 0 ), <j(0)) to a 
steady state which corresponds to a specified desired output y des - As in (61 )— (62), we are 
interested in finding a full state set point q des which maps to the desired output y des , and a 
feedforward u ^that cancels the extra terms in the error dynamical equation for A q = q-qdes- 
This means q des and ujj must satisfy the following equations: 

tfqdes-bujy = 0 

Cq d es 7 


72 


Vdes • 


( 101 ) 

( 102 ) 


Assume the leading components in b and c, bo and Co, respectively, are nonzero. Then the 
model matching equations (101 )— ( 102) imply 


u ff = 

Qdea 0 — 

c O 

Qdesi 0 

The error equation is then governed by 

q + fl 2 A q 


(103) 

(104) 

for i > 1. (105) 

= bu (106) 

= b T Aq (107) 


0 

Vdes 


where Aq = q - q de3 . 

A. 4. 2 Passivity 

In the error dynamical equation, fi 2 is only positive semidefinite. For internal stability, cf. 
section A. 4. 3 below, it is important that the stiffness matrix is positive definite. To achieve 
this, a proportional feedback loop is first closed: 

u = uj — k p b T q. (108) 

The effective closed-loop stiffness matrix is then 


ci 2 = n 2 + k p bb T . 


Since it is assumed that bo / 0, Q 2 is positive definite for any k p > 0. 

To show the mapping Ui to b T q is passive, consider the storage function 

v(x) = \ M 2 + l? T nV 

It is easily verified that the derivative of V' along the solution is V = ( b T q) T Ui . The passivity 
from Uj to b T q follows from the fact that V is a positive function. 


A. 4.3 Stabilization 

For the open-loop error system (106), the controllability matrix, after reordering the columns, 
is 


C = 


■ 0 
Co 



with 


c 0 = [b -n 2 b n 4 b ... (~n 2 ) n b }. 

Assume the modal frequencies are all distinct and every component of b is nonzero, then Co 
is invertible which means that the system is controllable. 
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The observability matrix with respect to y v for the open-loop error system is 


(9 = 


' 0 
.Co 


-n 2 c o' 
o 


Since Q 2 is singular, O is singular which means that the system is not observable from 
y v . However, with the proportional feedback of the motor position as in (108), H 2 in the 
observability matrix is replaced 

n 2 = H 2 + k p bb T 

Since P 2 is nonsingular, the observability matrix is also nonsingular and the system is ob- 
servable. 

By the Passivity Theorem, the hub velocity loop can be closed with any strictly passive 
feedback C v , i.e., 

Ui = u 2 - C v (b T q), 

and the resulting closed-loop system is i^-stable from u 2 to b T q. For the internal asymptotic 
stability, we need detectability. From the analysis above, it is evident that if the poles of 
C v do not cancel with the zeros of the system with proportional feedback, then the overall 
closed-loop system is controllable and observable, and, therefore, internally asymptotically 
stable. 

It is tempting to choose C v to be an SPR filter which, over certain bandwidth, approxi- 
mates the plant inverse (this is possible since the plant is passive, therefore, minimum phase). 
Then the I/O map from u 2 to b T q is approximately constant in that frequency range. This 
would result in an excellent I/O response; however, the internal state becomes almost un- 
observable which means a very poor internal state response. This has indeed been observed 
experimentally, where excellent step response is obtained at the hub but the beam oscillates 
at a frequency corresponding to the pair of zeros with the lowest frequency. 


A. 5 Application to Fully Actuated Robots 

The passivity property of fully actuated robots has been much exploited in recent years, 
starting from the path breaking work in [2] to many later extensions in, for example, [33, 4, 
5, 37] and many others. This section briefly reviews some of these results and shows how 
they fit into the framework outlined in Section A. 2. 

The equation of motion for a fully actuated arm is the same as that for the flexibly jointed 
robot (63) except for B = I and k = 0: 

M(6)0 + C{dj)e+g(0) = u. (109) 

Consider the set point control problem, i.e., the control objective is to steer an arbitrary 
initial condition (0(0), 0(0)) to a specified set point (0des,O). 

The first step is to choose a feedforward control to form the error system 

u = u 0 + U jj 
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where u jj may either be the gravity load cancellation or the gravity load at the desired set 
point: 

Uff = g{Qde S ) or (110) 

u ff = (in) 

In both cases, a position feedback loop needs to be closed to ensure a positive definite 
stiffness: 

u 0 =■ ui — K p A9 

where I\ p is positive definite. In the first case, K p should be chosen large enough so that 
the combination with the gravity potential energy is positive definite. To show the passivity 
from ui to 9, the following storage function can be used: 

V{9, 0) = -9 T M{9)9 + U(A9) (112) 

2 

where U is the total potential energy (including the position feedback loop) 

U{A9) = i A9 T K p A9 + G{A9 + 9 des )-G{9 des )-g(9 des ) T A0 for (110) 

U(A9) = A9 t K p A9 . for (111) 

Now, any strictly passive feedback from 9 to u 1 can be used: 


ui = u 2 - C v (9). 

By the Passivity Theorem, the closed-loop is L 2 ~st a ble from u 2 to 9. Since the stiffness term 
is globally positive definite, 9 is globally zero state detectable. Hence, the zero equilibrium 
of the error system is globally asymptotically stable. 

A. 6 Tracking Control Problem 

So far we have considered only the set point control problem. A good set point controller is 
an important facet of the control design as it implies good transient behavior in disturbance 
rejection (the initial error state can be considered as the result of the past disturbance). 
Another important aspect of the control design is the trajectory tracking problem. An 
intuitive approach is to simply replace 9 by A 9 in the set point controller with the hope that 
a well tuned set point controller would also imply good tracking. In this section, we will 
both justify and modify this intuitive approach. 

Given the general dynamical equation (59), consider the problem of finding a feedback 
control u so that the output y = C9 tracks an arbitrary trajectory y de3 asymptotically. A 
natural extension of the set point control approach presented before is to express the system 
dynamics in the error coordinate and choose a feedforward control ujj to cancel the extra 
terms in the dynamics, assuming that this is possible: 

M(9)A9 + C{9,9)A0 + f{9) - f{9 des ) = Bu 0 (113) 
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where u = u 0 + u jj has been used and 

Bu ff = M(0)0 dea + C{9,9)0 dea + f{9 des ) (114) 

is assumed to have a solution, given y de s{t) — C9 des {t), t > 0 (this issue is discussed in greater 
detail in Section A. 6. 4). Note that in contrast to the set point control case, not only is the 
model information required in the feedforward but, in general, the full state measurements 
as well. 

An important extension of (114) is to add to 0 dea with an error feedback, ^(Af^A#) 
(assume the equation is solvable). Then the feedforward to be solved is 

Bu ff = M(9)(9 dea - £(A 9, A6)) + C(O,0)9 dea + f(0 de3 ). (115) 

The solvability of this equation in the flexible joint robot case is discussed in section A. 6.4. 
The error equation with this feedforward becomes 

M(0)A0 + M(0)t(A0,A0) + C(0,0)A0 + f(0) - f(0 des ) = Bu 0 . (116) 

The additional term £ can now be chosen to augment performance (this is especially effective 
if M strongly couples different degrees of freedom). 

Next close a position loop: 

u Q = ui — K p B T A9 

where it is assumed that I\ p can be chosen sufficiently large so that BK P B T + V ef(9des) > 0 
(same as the set point case). The problem is that f(9 des ) is now time varying and, conse- 
quently, the passivity property from u x to A0 cannot be easily shown as before (an exception 
is when / is linear, a fact we shall use in section A. 6. 2). There are three approaches to ap- 
proach this issue: 

1. The only time varying term in the error system is due to 9 dea . For each fixed time, the 
same passivity analysis as before can be applied to show local asymptotic stability. By 
applying a well known theorem for time varying systems [38], closed loop asymptotic 
stability is preserved if 0 dea is sufficiently slow time varying. 

2. If the feedforward torque, un, is chosen to compensate for g{9) rather than for g(9 d es), 
provided that it is solvable, then the passivity analysis can again be applied. 

3. Define a new output 2 = B T 0 + gB T 0 where g is a small positive parameter. If B = I 
(full actuation case) or there is inherent structural damping D such that D + BI\ V B T is 
positive definite for some K v > 0, then the map from to 2 is passive for g sufficiently 
small, and the same passivity analysis can be applied. 

In the remainder of this section, we will elaborate on each of these approaches, and also 
discuss in detail the solution of the feedforward torque. 
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A. 6.1 Tracking for Slowly Varying Trajectories 

To apply the stability result for slowly time varying systems, the feedforward in (114) needs 
to be slightly modified to 


B u ff— M(9)9 de3 + C(9,9)9 des + C(9,9 de3 )A9 -f f(0 des ). (117) 


Then the error equation becomes 

M(9)A9 + C(9 , A9)A9 + f{9) - f{9 des ) = Bu 0 . (118) 

In (118), the only time varying quantities are 9 des and 9 des . If they are “frozen” at a particular 
constant value ( 9 de3 ,9 des ) = (9 de3 (T),0 des (T)) where T > 0 is a constant, then the derivative 
of the following scalar function 

V(A0,A0) = ^A9 T M(A9+9 de3 )A9 + U(A9 + 9 de3 )-A9 T f(9 de3 )-U{9 des ) + ^A9 T BK p B T A9 

is V = A9 T Bui, where U is the potential energy corresponding to / and BI\ P B T + Vgf(O des ) 
is assumed to be positive definite uniformly in 9 des . Hence, the stabilizing control law design 
based on the passivity approach as described in the previous sections (with 9 replaced by A0) 
stabilizes all frozen systems. Under the additional assumption that the frozen systems are 
locally uniformly (with respect to T ) exponentially stable, the slowly time varying theorem 
as stated in [38, Theorem 5.6.6] can be applied to show local exponential stability of the 
closed loop system provided sup 4 max {9 des (t), ^ es (0} is sufficiently small. Simulations in 
[l] confirm this result, where a slowly time varying sinusoid can be closely tracked, but not 
a fast time varying sinusoid. 

A. 6. 2 Tracking by Direct Compensation 

Another possibility is to directly compensate for part of f(9) in (113). The feedforward 
torque that needs to be solved is now 

Bug = M(9)9 des + C(9,9)9 des + f x {9) + F9 des (119) 

where we have decomposed f(6) according to f(9) = fi(9) +F9 where F is a square matrix. 
The reason that we decompose / in this fashion is related to the solvability of (119) (see 
section A. 6. 4 for detail). 

Assume that a solution exists, then the error equation is of the form 

M{9)A9 + C(9 , 9) AO + FA9 = Bu Q . (120) 

Now the same passivity analysis as before can be applied for the control law 

u 0 = -K P B T A9-C V (A9) (121) 


for any strictly passive C v . 
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A. 6. 3 Tracking by Output Modification 

Even in the local version of (113), with f{9)—f(9 des ) replaced byV g f(9 des )A9,V e f(9 de3 ) > 0, 
the map from u 0 to B T A9 is still not passive in general. This can be seen by evaluating the 
innerproduct between this input/output pair: 

T T 

[ ( B T A9) T u 0 dt = [ A6 T {M(9)A9 + C(9,9)A9 + V g f{9 des )A9)dt 

Jo Jo 

= iA# r M(0)A«| o T + ±Ae T V t f(0 d ',)A0\ T o 

1 T 7 

-- / A8 T -(V g f(9 des ))A9dt. (122) 

l Jo at 

Since ^(Vg/(^e s) may be sign indefinite, the integral cannot be bounded below by a con- 
stant. To counter the effect of this last term, we consider adding a proportional feedback, 
B t A9. The contribution to the input/output innerproduct due to this addition is 


[ T (B t A9) t u 0 dt = f T A9 t (M(9)A9 + C(9, 9)A9 + V 9 f(0 des ) A9) dt 

Jo Jo 

= A9 t M(9)A9 T - [ T (A9 t M(9)A9 + A9 T (M(9, 9) - C{9, 9))A9) dt 

o Jo 

+ f T A9 t V ef {9 des )A9 dt. (123) 

Jo 


For the local analysis, we shall ignore the higher order term ( M(9,9 ) — C(9,9)). Now, 
consider adding a static PD loop: 

u 0 = —K p B T A9 — I( V B T A9 + Uj. (124) 

Then the innerproduct between and B T A9 is the same as (122) except V gf{9 des ) is 
replaced by V g f{9 dea ) + BI\ P B T and there is an additional term: 

F A9 T BI< V B T A9 dt. 

Jo 

The innerproduct between u\ and B T A9 are the same as (123) except V ef{9 des ) is replaced 
by V 5 /(^ es ) + BK P B T and there is an additional term: 

It- ~ \T 

-A9 t BK v B t A9\ . 

2 lo 


Now form the augmented output 

z = B t A9 + cB t A9. 

For c sufficiently small and 9 de3 sufficiently slowly time varying, all terms in / 0 T z T (t)u x (t ) dt 
can be bounded below- by a constant except for the integral involving the quadratic term in 
A 9 which is Jq A9 t (—cM(0) + BK V B T )A9 dt. There are two situations in which this term 
is also bounded below by a constant: 
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1. The arm is fully actuated, i.e., B = I. This approach is the same as in [39]. 

2. There is an inherent damping, DO, which gives rise to the term DAO in the error equa- 
tion (the feedforward ug needs to be modified accordingly). If D + BK V B T is positive 
definite, then for c sufficiently small, the integral is bounded below by a constant. 

If either of the above situation holds, then the map from u i to z is passive and the same 
analysis can be carried as before to generate stabilizing control laws based on passive map 
from z to ui. In the example in [1], it has been shown that link damping in the flexibly 
jointed robot allows tracking of a fast trajectory that could not be tracked when the damping 
is absent. 

A. 6. 4 Derivation of the Feedforward Compensation 

Flexible Joint Robot Case 

To form the tracking error dynamic equation, we need to solve for in either (114) or 
(119). In this section, we will consider this problem for the special cases of flexible jointed 
robot and a single flexible link. 

We will consider only the simplified flexible joint model given in (86)-(87); the general 
case is considerably more complicated. Suppose y = 6 (. Then (114) involves solving for 
(ug(t),0 mdea (t),0 mdea (t)), given 9f dra (t) and its higher time derivatives (as many as required) 

and (9 m (t),6m(t),de(t),0e(t)), from the following set of equations: 

Mi(0 ( )0( des + C\(0 t ,9 ( )0 tdea + g\{0t dS3 ) + h {N9 tdca - 0 mdaa ) = 0 (125) 

Im0m d ',-h(N9,. d ' a -0 mi J = Ug (126) 

Assuming k\ is monotonically increasing so an inverse function k~ l exists. Assume k\ is 
twice differentiable. Then 0 mdaa can be solved from (125): 

= w,,.. + »,(«<*.)])• (127) 

To solve u^-from (126), 9 mdta must first be computed. This can be done by differentiating 
(127) twice: 

L d „ = W., - ^[i, M,(e,)0 u „ + C,(0,A)k., + Ji(«<*.)])]- (128) 

Note that the second term involves Of and 9e, which can in turn be resolved using the 
dynamic equation (86) and its derivative. Finally, ug can be computed from (126). 

For the direct compensation case, cf. (119), the feedforward compensation equation based 
on the simplified flexible joint model is 

M\{9i)9f ita + Ci(9f,9f)0f dca + gi(Of) 

+k 2 (N9 e - 0 m ) + K(N9f dea - 9 md J = 0 (129) 

Ij md „ - h(N9 e - 9 m ) - I\(N9f dca - 9 md J = u ff (130) 
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where K is any square invertible matrix and k 2 is chosen from k 2 [x) = ki(x) — Kx. Following 
similar steps as before, (129) can be used to solve for 9 mdcs : 

Orn dc , = A l (—Mi (0()0 (de3 — C x {0 t , 9t)9i dt , — 9i{^e) — k 2 (N9 e — 0 m )) + N 9 (dcj . (131) 

To solve for li^from (130), again 9 md3i needs to be computed by directly twice differentiating 

both sides of (131). However, 9 mdes now not only contains &e and 9i which can be resolved 
using the dynamical equation and its derivative as before, but also 9 m (through the derivative 
of k 2 ) which in turn depends on ujf. Therefore, to solve ujj, we need the invertibility of 

I — I m K~ 1 'V x k 2 (x) 7 m -1 for all 9i and 9 m , which does not appear to be a severe 

limitation. Note that if the spring is assumed to be linear as common practiced in the 
literature, this additional assumption would not be needed. 

For flexible joint robots, Eq. (115) can be solved in exactly the same fashion as above. 
A simple but useful choice of the function £ is simply 

£(A9, A 9) = K pe A9 + K vt A9. (132) 

The closed loop equation is now of the following form 

Mi(9t)A9( + C\(9(, 9()A9( gi(9() — gi(@e de3 ) 

— 9 m ) — ki(N9i dea — 9 mde3 ) + K V( A9( + h Pt A9{ — 0 (133) 

I m A 9 m — k\{N9( — 9 m ) + ki(N9( di;3 — 9 mdds ) + k p A9 m = u\ (134) 

The system linearized about (A0, A 9) — (0, 0) is passive between u x and A 9 m since the 
stiffness matrix 

' + M(6, d „)K r , -NVk(N0 ld „-e md J ' 

-NVk(M ld " - e nd „) vk(N0 tddi - e md j + k , J 

is positive definite. Hence, any strictly passive loop between A 9 m and u x can be closed to 
ensure closed loop asymptotic stability of the error system. 

The purpose of the feedforward control can be thought of as winding up the spring torque 
so that the link dynamics is governed by 

A 9( + K V( A9( + A P/ A0( = 0. 

The role of the feedback control is to produce the motor trajectory that is required for this 
feedforward. 

Flexible Link Case 

For the flexible link case, the situation is quite different since the acceleration of the 
actuated degrees of freedom are not decoupled from the acceleration of the unactuated 
degrees of freedom as in the simplified model of a flexibly jointed robot. We now need to 
solve for (««•, qq es ) given a desired output trajectory y de5 \ 

Qdes A 9des Bit 

C 9des = lldes 


80 


(135) 

(136) 



with the additional constraint that ujj needs to be uniformly bounded for implementability. 
This problem is almost identical to the inverse plant problem considered by [40], but here we 
solve for the desired plant trajectory rather than the actual plant trajectory. Consequently, 
while the control law obtained in [40] is entirely open-loop, here we have a feedback control 
structure. 

To analyze the solution of ( 1 35)— ( 136), first express qd es is of the following form: 

Qdes = C+y t ies + C£ (13?) 

where = C T {CC T )~ l is the pseudo-inverse of C and C is the n x (n — m) full rank matrix 
that is annihilated by C {CC = 0). Note that C can be formed by the linearly independent 
columns of ( I — C + C), but C ^ (I — C + C) since C is full rank. 

Differentiating the equation twice, we have 

ijdea = C ijdes 4“ 

Substitute back into (135) and assume B is full rank, we can solve for ug. 

u ff = ( B t B )~ l ( B T C + y des + B t C( + B T n 2 (C+y dea + C()). (138) 

Now, Ujj can be eliminated from (135), and after rearranging terms, we obtain 

(7 - B(B T B)~ l B T ){Ci + n 2 CO = -(7 - B{B T B)- l B T )(C + y des + tfC + y des ). (139) 
Since 'R(C) C R n and R n = 71(B) © J\T(B T ), C can be decomposed as 
C = BK X + B? I <2 i.e. jV = [ B B? ] _1 C 

where B T € R” x ( n_rn ) is full rank and annihilated by B, i.e., B r B T = 0, and K 2 £ 
p^(n-m)x(n-m)c j g S q Uare invertible. Then (139) becomes 

BTK 2 l+{I - B{B T B)- l B T )tfCt, = -(7 - B{B T B)- 1 B T )(C + y des + n 2 C*y des ). 

After multiplying through K 2 T B TT , and noting B tT is the annihilator of B , we obtain 

£ + (7v 2 T R ?T S ? A' 2 )- 1 7\ 2 T R 5;r f2 2 Ce 
= -{K 2 T & T WK 2 )- l K 2 T lF T {C + y dea + tfC + y dea ). (140) 

Writing the above equation in a more compact form, we have 

i + \t = Lp (141) 

where p = ^ y de3 y des j T . For implementability, the initial condition, (£(0),£(0)), needs to 
be chosen so that £(£) is uniformly bounded for all t. There are two equivalent approaches 
to find the initial condition. A Laplace transform approach was stated in [40] and a time 
domain approach in [41]. We will discuss both approaches here. 


81 



In the first approach, the Laplace transform of (141) is taken: 


£(s) = (s 2 I + A)- l (Lp(s) + S tiO)+aO)). 


Suppose p(s) is analytic in the open right half plane and has only simple poles on the 
imaginary axis (i.e., ydes(t) is uniformly bounded), then the terms in £(s) that can lead to 
unbounded time response are only those associated with the unstable roots of det(s 2 / + A). 
Since A is n — m x n — m, there can be at most n — m unstable roots. Correspondingly, there 
are n — m R m residue vectors which, when the contributions in ug are all set to zero, lead to 

m(n — m) equations. There are 2(n — m) constants that we can choose in (£(0), £(0)). Hence, 
if m = 2, an initial condition can be chosen in general to nullify the residues associated with 
the unstable poles. If m = 1, all residues can be nullified, implying the time response of £(f) 
is zero after some finite t. The requirement that m < 2 appears to be unnecessarily strong 
as will be evident from the time domain analysis below. 

An equivalent time domain approach can also be taken. First write (141) in the first 
order form: 


' i ' 


0 1 ' 

' f ' 


■ 0 ' 


A. 

— 

-A 0 

A. 

+ 

L 

P 


After transforming the coordinate according to the stable (including eigenvalues on the 
imaginary axis) and unstable eigenspace, the system is partitioned as 


7+ 

7- 


A + 

0 


0 

— A_ 



P 


where A + and A_ are both strictly unstable. The unstable response is given by 

7+« = e A *V(0)+ fe^‘- r 'L + p(T)iT 

Jo 

= e A *‘( 7+ (0)+ ['e-^’LMr)dr) 

Jo 

Choose 

7+(0) = -/ e~^L + p{r)dr 
Jo 

assuming the integral exists (which is true if jjd es is uniformly bounded). If 

(7+(0)+ f* z~ A+t L+p(t) dr) < Me~ ,T+t 
Jo 


(142) 

(143) 


where cr + is the eigenvalue of A+ with the largest real part, then 7 +(t) would be uniformly 
bounded as required. Again, a sufficient condition for this is that yd es is uniformly bounded. 
Note that the condition on the number of input/output pairs is no longer required in this 
analysis. This discrepancy appears to be due to some relationship in the residues that we 
are not taking advantage of. 

As in the Laplace transform approach, 7_(0) can be chosen to achieve the zero steady 
state for 7+ and if / 0 °° e A_r L-p(r) dr < 00. 

In [40], it was pointed out that the procedure of choosing the initial condition to guarantee 
the boundedness of ug is highly sensitive numerically since any slight numerical error could 
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lead to divergence. To show that 7 +(t) in (143) can be computed in a numerically stable 
way, we substitute (143) into (142). Then 


/ OO 

(e- A *V + p(r))rfr 

/ CO 

e ^( t -r) L+ p(T)dT 

J ro o 

' e~^ +T L + p(t -f r) dr 

0 


(144) 


where the last expression can be stably calculated since — A + is stable. 

To illustrate the procedure described above, consider a simple example presented in [40]: 


9 + 


1 -1 

-1 1 


y = 


0 1 }q- 


1 

‘3 J 


u 


After some algebra, we obtain 
where 


Vdes — \ 


i 2 ijdes 

(145) 

0 < t < 1 


1 < t < 2 

(146) 

t > 2 . 



and j/dei( 0 ) = 2/*s(0) = 0 . For simplicity, make a change of variable 77 = £ — y, then 

7 ? - 7 = -3ydes- 

The Laplace transform of is 

(1-e-*) 2 


Therefore, 


V{s){s) = 


Vdes{s) = 


(- 3 s ! (1 — e s ) 2 + 577 ( 0 ) + 77 ( 0 )) 
s 2 - 1 


If only the unstable residue is to be canceled as suggested in [40], one choice for the initial 
condition is 

r;(0) = >j(0) = |(1 - e- 1 ) 2 . (147) 


In this case, since m = 1, residues associated with both poles can in fact be canceled by 
choosing 

f((l-e ‘ 1 ) 2 + (l-e) 2 ) 

-|(-(l-e - 1 ) 2 + (l-e) 2 ) 

An equivalent time domain approach can also be taken. The solution of (145) is 


77(0) 


. W . 



(148) 


l(t) = 


cosh t sinhi 
sinh t coshi 


7)(0) 

-HO) 


■j: 


cosh r — sinh t 
- sinh t cosh r 


0 

1 


ydes{r)dTy 
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After using (146), the integral, for t > 2 , is a constant: 


/' 
J o 


cosh r 

— sinh r 

' 0 ‘ 

ydes{r)dT = 

1—2 cosh 1 + cosh 2 

— sinh r 

cosh r 

1 

2 sinh 1 — sinh 2 


Since the stable eigenspace is spanned by 


1 

-1 


and the unstable eigenspace is spanned by 


, choosing the initial condition according to (147) leads to 


i}(t) = e '(1 4 - e 2 — 2 e) 

for t > 2 and choosing the initial condition according to (148) leads to 77 (f) = 0 for t > 2. 

When the desired output is assumed generated from a reference model and the model and 
plant parameters satisfy a model matching condition, a solution of ( 1 35)— ( 1 36) can be more 
easily solved. This is called the regulator approach, a version of which, called the command 
generator tracker theory, was proposed in [ 12 ]. The nonlinear version can be found in [42]. 
Application to the flexible arm control can be found in [43]. We present this approach for a 
general linear time invariant system. Consider 

ides . — T Bll^ 

Vdes Cxjgg. 

The desired output yd es is generated from a linear time invariant reference model: 


w = Sw 

Vdes = Qw 

where w £ R fc . We seek a solution of the form 


Uff= Fw (149) 

where F and a matrix P together should satisfy 

PS-AP = BF (150) 

CP = Q (151) 

which are called the model matching conditions. The initial condition x dej (0) should be 
chosen as 

x de *(0) = Pw( 0). (152) 

Clearly, if the exosystem is stable, the feedforward signal will be uniformly bounded. 

The model matching condition (150) can be written as a generalized Lyapunov equation: 


A -B ' 

’ P ‘ 


' P ' 


' 0 ‘ 

C -S 

F 

+ 

F 

S = 

. Q . 


(153) 
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where the unknown matrix 


P 

F 


is of dimension (n + m) x k. By using the Kronecker 


product, this linear matrix equation can be written as a vector equation: 


(A ® h 4- In+m ® S)x = 7 


(154) 


where 


A 


-A -B 
C -S 


and x an d 7 are the columnwise stacked vector from 

given plant and exosystem, the solvability of (154) can be readily checked, and if solvable, x 
can also be easily found. A sufficient condition (for the invertibility of the matrix in (154)) 
is that the spectrum of —A and 5 do not intersect. 

The feedforward u^given by the linear regulator approach is a particular solution of (138) 
from the plant inversion. It would be interesting to query if the initial condition chosen as in 
(152) is related to the initial condition chosen based on the plant inversion approach described 
earlier (either through the Laplace transformation or time domain solution). In Appendix 
A, it was shown for a single flexible link tracking a sinusoid, that the initial condition from 
the regulator approach is the same as the one chosen to cancel all of the residues. We are 
currently seeking the generalization of this result. 


and 


0 

Q 


, respectively. For a 


A. 7 Adaptive Control 

The feedforward control in either set point or tracking case requires a great deal of model 
information. It is highly desirable to adaptively update this signal without requiring explicit 
knowledge of the plant parameters. To this end, consider the closed loop system as an 
internally asymptotically stable system driven by the input u jj. Based on our passivity 
approach, the closed loop system is passive but in general not strictly passive. Our basic 
idea is to choose a new output such that the I/O pair with respect to this output is strictly 
passive. Then any passive adaptation for ujj r can be used to preserve the state asymptotic 
stability. 

We will only consider the linearized closed loop plant here, the full nonlinear version is 
under development. Suppose that the linearized closed loop plant is of the form 

x = Ax + B{u — u jj) 

where .4 is exponentially stable, u«ris the unknown desired feedforward, and u is the adaptive 
feedforward. By the Lyapunov’s theorem [44], for any Q > 0 , there exists P > 0 such that 

A t P + PA = -Q. 

Now- define C = B T P as the new output map. Then the triplet (.4, B,C) is strictly positive 
real [45]. The adaptation for ujf is now straightforward. Using the standard linear-in- 
parameter formulation [46], suppose ujj can be parameterized as 

u ff =H\ 
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where H in the known regressor matrix and A is the unknown parameters. For the set point 
control case, H = I and A is a constant vector. For the regulator approach, H contains 
w (state of the exosystem) and A consists of columns of F (cf. (149)). For the tracking of 
a general desired output, H depends on 9, 9 , and its higher derivatives. In this case, 
finding the structure of H itself may be difficult. A viable approach may be to approximate 
H by some expansion and slowly adapt the approximation. The neural net approach in [47] 
is a possibility that we shall explore. 

To derive the adaptation rule, consider the Lyapunov function candidate 

V = x T Px + AA T r _1 AA (155) 


where A A = A — A, A is the estimate of the unknown vector A. Since the output is chosen so 
the system is strictly positive real, the derivative along the solution becomes 


V = -x t Qx + 2 (u — u ff) T y + 2 AA T r- x AA. 
Choose the adaptive feedforward based on the estimated parameter: 

u ff = H A. 

Then 

V = -x t Qx + 2AA T {H T y + r - 1 AA). 
Hence, with the following gradient update rule for A: 

A = -r H T y 


(156) 


(157) 


V is negative semidefinite. This implies that all states and parameter estimate error are 
bounded, and furthermore, by Barbalat’s Lemma [48], x converges to zero asymptotically. 
For the set point control case, the adaptive parameter update simply reduces to the integral 
control law. 

We are currently extending this argument to the nonlinear systems by using the nonlinear 
Lyapunov equation. 
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